summaryrefslogtreecommitdiff
path: root/src/c/signalProcessing/kalm/zkalma.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/c/signalProcessing/kalm/zkalma.c')
-rw-r--r--src/c/signalProcessing/kalm/zkalma.c119
1 files changed, 0 insertions, 119 deletions
diff --git a/src/c/signalProcessing/kalm/zkalma.c b/src/c/signalProcessing/kalm/zkalma.c
deleted file mode 100644
index f47e01e..0000000
--- a/src/c/signalProcessing/kalm/zkalma.c
+++ /dev/null
@@ -1,119 +0,0 @@
-/* Copyright (C) 2017 - IIT Bombay - FOSSEE
-
- This file must be used under the terms of the CeCILL.
- This source file is licensed as described in the file COPYING, which
- you should have received as part of this distribution. The terms
- are also available at
- http://www.cecill.info/licences/Licence_CeCILL_V2-en.txt
- Author: Abhinav Dronamraju
- Organization: FOSSEE, IIT Bombay
- Email: toolbox@scilab.in
- */
-
-/*Function to find kalm */
-
-#include "lapack.h"
-#include "stdlib.h"
-#include "doubleComplex.h"
-#include "stdio.h"
-#include "string.h"
-#include "kalm.h"
-#include "matrixTranspose.h"
-#include "matrixMultiplication.h"
-#include "matrixInversion.h"
-#include "addition.h"
-#include "subtraction.h"
-#include "eye.h"
-
-void zkalma(doubleComplex* y, int y_row, int y_col, doubleComplex* x0, int x0_row, int x0_col,doubleComplex* p0, int p0_row, int p0_col, doubleComplex* f, int f_row, int f_col, doubleComplex* g, int g_row, int g_col, doubleComplex* h, int h_row, int h_col, doubleComplex* q, int q_row, int q_col, doubleComplex* r, int r_row, int r_col, doubleComplex* x1, doubleComplex* p1, doubleComplex* x, doubleComplex* p)
-
-{
- doubleComplex k[p0_row*h_row];
- doubleComplex h_trans[h_col*h_row];
- doubleComplex temp1[p0_row*h_row];
- doubleComplex temp2[h_row*p0_col];
- doubleComplex temp3[h_row*h_row];
- doubleComplex temp4[h_row*h_row];
- doubleComplex temp5[h_row*h_row];
- doubleComplex temp6[p0_row*p0_col];
- doubleComplex temp7[p0_row*h_col];
- doubleComplex temp8[p0_row*p0_col];
- doubleComplex f_trans[f_col*f_row];
- doubleComplex g_trans[g_col*g_row];
- doubleComplex temp9 [f_row*p0_col];
- doubleComplex temp10[f_row*f_row];
- doubleComplex temp11 [g_row*q_col];
- doubleComplex temp12[g_row*g_row];
- doubleComplex temp13[h_row*x0_col];
- doubleComplex temp14[h_row*x0_col];
- doubleComplex temp15[p0_row*x0_col];
-
-
-
- ztransposea(h, h_row, h_col, h_trans);
- zmulma(p0, p0_row, p0_col, h_trans, h_col, h_row, temp1); //temp1= p0*h'
- zmulma(h, h_row, h_col, p0, p0_row, p0_col, temp2); //temp2= h*p0
- zmulma(temp2, h_row, p0_col, h_trans, h_col, h_row, temp3); //temp3= h*p0*h'
- zadda(temp3, h_row*h_row, r, r_row*r_col, temp4); //temp4= h*p0*h'+r
-
-/*//Debug Only*/
-/* for(int i=0; i< h_row*h_row; i++)*/
-/* printf("temp4[%d] = %lf + i %lf\t",i, zreals(temp4[i]) , zimags(temp4[i]));*/
-/* printf("\n");*/
-
- zinverma(temp4, temp5, h_row); //temp5= (h*p0*h'+r)**(-1)
-
- zmulma(temp1, p0_row, h_row, temp5, h_row, h_row, k); //k=p0*h'*(h*p0*h'+r)**(-1)
-
-/*//Debug Only*/
-/* for(int i=0; i< p0_row*h_row; i++)*/
-/* printf("k[%d] = %lf \t",i, k[i]);*/
-/* printf("\n");*/
-
-
- zeyea(temp6, p0_row, p0_col); //temp6 = eye(p0)
- zmulma(k, p0_row, h_row, h, h_row, h_col, temp7); //temp7 = k*h
- zdiffa(temp6, p0_row*p0_col, temp7, p0_row*h_col, temp8); //temp8= eye(p0)- k*h
- zmulma(temp8, p0_row, p0_col, p0, p0_row, p0_col, p); //p=(eye(p0)-k*h)*p0
-
-/*//Debug Only*/
-/* for(int i=0; i< p0_row*p0_col; i++)*/
-/* printf("p[%d] = %lf \t",i, p[i]);*/
-/* printf("\n");*/
-
-
- ztransposea(g, g_row, g_col, g_trans);
- ztransposea(f, f_row, f_col, f_trans);
- zmulma(f, f_row, f_col, p, p0_row, p0_col, temp9); //temp9= f*p
- zmulma(temp9, f_row, p0_col, f_trans, f_col, f_row, temp10); //temp10= f*p*f'
- zmulma(g, g_row, g_col, q, q_row, q_col, temp11); //temp11= g*q
- zmulma(temp11, g_row, q_col, g_trans, g_col, g_row, temp12); //temp12= g*q*g'
- zadda(temp10, f_row*f_row, temp12, g_row*g_row, p1); //p1=f*p*f'+g*q*g'
-
-/* //Debug Only*/
-/* for(int i=0; i< f_row*f_row; i++)*/
-/* printf("p1[%d] = %lf \t",i, p1[i]);*/
-/* printf("\n");*/
-
-
- zmulma(h, h_row, h_col, x0, x0_row, x0_col, temp13); //temp13= h*x0
- zdiffa(y, y_row*y_col, temp13, h_row*x0_col, temp14); //temp14= y-h*x0
- zmulma(k, p0_row, h_row, temp14, h_row, x0_col, temp15); //temp15= k*(y-h*x0)
- zadda(x0, x0_row*x0_col, temp15, p0_row*x0_col, x); //x=x0+k*(y-h*x0)
-
-/* //Debug Only*/
-/* for(int i=0; i< x0_row*x0_col; i++)*/
-/* printf("x[%d] = %lf \t",i, x[i]);*/
-/* printf("\n");*/
-
-
- zmulma(f, f_row, f_col, x, x0_row, x0_col, x1) ; //x1= f*x
-
-/* //Debug Only*/
-/* for(int i=0; i< f_row*x0_col; i++)*/
-/* printf("x1[%d] = %lf \t",i, x1[i]);*/
-/* printf("\n");*/
-
-
-
-}