Add matrix and kf code

README.md

@@ -1,3 +1,15 @@
-# sta-peak
+# Performant Embedded Algebra Kit (PEAK)
+
+
+> ⚠️ **Warning:** WORK IN PROGRESS and UNTESTED
+
+
+## Description
+
+The Performant Embeddded Algebra Kit (PEAK) is a lightweight and easy-to-use library for performing various algebraic operations.
+
+## Features
+
+- Matrix operations: Perform matrix addition, subtraction, multiplication, and inversion.
+- Kalman Filter implementation
 
-The Performant Embedded Algebra Kit (PEAK) provides structures, classes and functions for various algebraic operations.