aboutsummaryrefslogtreecommitdiff
path: root/attic/dave/main.c
diff options
context:
space:
mode:
authorCNLohr <charles@cnlohr.com>2018-04-15 20:41:39 -0400
committerGitHub <noreply@github.com>2018-04-15 20:41:39 -0400
commit63daf8c314ed3111fb8d45822c547f5e526d84bd (patch)
tree927d843a553ef53217c283f19f16728b0ca51c50 /attic/dave/main.c
parent39a63badbb5864314a9d9e18c0871718ac5d2912 (diff)
parent69b31d3c3b1957e59d7962722a4145bfb0db16f9 (diff)
downloadlibsurvive-63daf8c314ed3111fb8d45822c547f5e526d84bd.tar.gz
libsurvive-63daf8c314ed3111fb8d45822c547f5e526d84bd.tar.bz2
Merge pull request #129 from cnlohr/tcc_build
Improved Makefile system.
Diffstat (limited to 'attic/dave/main.c')
-rw-r--r--attic/dave/main.c29
1 files changed, 29 insertions, 0 deletions
diff --git a/attic/dave/main.c b/attic/dave/main.c
new file mode 100644
index 0000000..ff187aa
--- /dev/null
+++ b/attic/dave/main.c
@@ -0,0 +1,29 @@
+#include <stdio.h>
+#include "kalman_filter.h"
+
+int main()
+{
+ KAL_VEC(xhat_k_km1); /* OUTPUT: (S) Predicted state at time 'k' */
+ KAL_MAT(P_k_km1); /* OUTPUT: (S x S) Predicted covariance at time 'k' */
+ KAL_MAT(P_km1_km1); /* INPUT: (S x S) Updated covariance from time 'k-1' */
+ KAL_VEC(xhat_km1_km1); /* INPUT: (S) Updated state from time 'k-1' */
+ KAL_MAT(F_k); /* INPUT: (S x S) State transition model */
+ KAL_MAT(B_k); /* INPUT: (S x U) Control input model */
+ KAL_VEC(u_k); /* INPUT: (U) Control vector */
+ KAL_MAT(Q_k); /* INPUT: (S x S) Covariance of process noise */
+
+ KalmanPredict(
+ xhat_k_km1, /* OUTPUT: (S) Predicted state at time 'k' */
+ P_k_km1, /* OUTPUT: (S x S) Predicted covariance at time 'k' */
+ P_km1_km1, /* INPUT: (S x S) Updated covariance from time 'k-1' */
+ xhat_km1_km1, /* INPUT: (S) Updated state from time 'k-1' */
+ F_k, /* INPUT: (S x S) State transition model */
+ B_k, /* INPUT: (S x U) Control input model */
+ u_k, /* INPUT: (U) Control vector */
+ Q_k, /* INPUT: (S x S) Covariance of process noise */
+ 36, /* INPUT: Number of dimensions in state vector */
+ 36); /* INPUT: Size of control input vector */
+
+ return 0;
+}
+