#include "ADDS_21161_EzKit.h"
#include <def21161.h>

#include <signal.h>
#include <math.h>
#include <stdio.h>

const int i=4;//ilosc wierszy macierzy
const int j=4;//ilosc kolumn macierz
const int n=3;//ilosc kolumn/wiersz w macierzy Amtrix_A_inv

//dane umieszczone w pamiêci danych (DataMemory)
int dm vector[4]={2,3,4,5};
int dm macierz1[3][4];
float dm mat_a[4][4]={1,2,3,4, 5,6,7,8,  9,10,11,12,  13,14,15,16};
float pm vector_X[4]={1,0,1,0};
float dm vector_Y[4];

float pm mat_X[4][4]={1,0,2,1, 0,1,1,0, 1,0,1,0, 1,0,0,1};
float dm mat_Y[4][4];
float dm mat_X_inv[4][4];
float dm matrix_A[9]={ 1,2,3, 11,12,13, 21,22,23 };
//taka macierz A umieszczona w pamiêci programu (ProgramMemory)
float pm matrix_A_PM[9]={ 1.0, 2.0 ,3.0, 11.0,12.0,13.0, 21.0,22.0,23.0 };

/*	Deklaracja elementow potrzebnych do odwrocenia macierzy*/
float pm matrix_A_inv[3][3]={-3,6,9, 10,-5,12, 4,-12,7};
int pm pf[4];
int pm swc[3];
int dm swr[3];
float dm det[1]={3};



int wiersz,kolumna;
int count_start();
int count_end(int);
int time_start, time_elapsed;

void dodawanko();
void mat_x_vec();
void mat_x_mat();
void mat_inv();
void mat_det_3x3();
void operacje_macierzowe();
void	main()
{ 
//#### transpozycja macierzy ####
//printf("\nMacierz A: \n");
operacje_macierzowe();
		
//###########################


	while (1)  //pêtla nieskonczona
	{
		asm("nop;");
	}
}

void operacje_macierzowe()
{
mat_x_vec();	
 	printf("\nMnozenie macierzy przez wektor - procedura w asemblerze\n");	
 	printf("\n			 	A[][]				x 	  X[]  =   Y[]\n\n");	
	for(wiersz=0; wiersz<j; wiersz++)
	{
//		for(kolumna=0; kolumna<i;kolumna++)
		{
			printf("%6.1f%6.1f%6.1f%6.1f    %6.1f    %6.1f ",
			mat_a[wiersz][0],mat_a[wiersz][1],mat_a[wiersz][2],mat_a[wiersz][3],
			vector_X[wiersz],vector_Y[wiersz]);
		}
		printf("\n");
	}
	
mat_x_mat();
 	printf("\nMnozenie macierzy przez macierz - procedura w asemblerze\n");	
 	printf("\n			 	A[][]   	   	 x  			 X[][]			=				Y[][]\n\n");	
	for(wiersz=0; wiersz<j; wiersz++)
	{
		//for(kolumna=0; kolumna<i;kolumna++)
		{
		printf("%6.1f%6.1f%6.1f%6.1f    %6.1f%6.1f%6.1f%6.1f    %6.1f%6.1f%6.1f%6.1f  ",
		mat_a[wiersz][0],mat_a[wiersz][1],mat_a[wiersz][2],mat_a[wiersz][3],
		mat_X[wiersz][0],mat_X[wiersz][1],mat_X[wiersz][2],mat_X[wiersz][3],
		mat_Y[wiersz][0],mat_Y[wiersz][1],mat_Y[wiersz][2],mat_Y[wiersz][3]);
		}
		printf("\n");
	}

 	printf("\nPoszukiwanie macierzy odwrotnej\n");	
 	printf("\n			 	A[][]\n\n");	
	for(wiersz=0; wiersz<n; wiersz++)
	{
		for(kolumna=0; kolumna<n;kolumna++)
		{
		printf("%6.1f ",matrix_A_inv[wiersz][kolumna]);
		}
	printf("\n");   
	}
mat_det_3x3();	//procedura obl wyznacznika
	printf("\n Wyznacznik:");
	printf("%6.1f ",det[0]);
	
//mat_inv();	
 	printf("\nWyznaczona macierz odwrotna\n");	
 	printf("\n			 inv A[][]\n\n");	
	for(wiersz=0; wiersz<n; wiersz++)
	{
		for(kolumna=0; kolumna<n;kolumna++)
		{
		printf("%6.1f ",matrix_A_inv[wiersz][kolumna]);
		}
		printf("\n");
	}
	
}