From 8585e34c7320235c3d3222c31158d0aa62396cfa Mon Sep 17 00:00:00 2001
From: Thefeli73 <thefeli73@hotmail.com>
Date: Tue, 13 Apr 2021 23:43:54 +0200
Subject: [PATCH] K matrix

---
 EENX15_LQR/LQR.ino | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/EENX15_LQR/LQR.ino b/EENX15_LQR/LQR.ino
index 499930f..1420c8c 100644
--- a/EENX15_LQR/LQR.ino
+++ b/EENX15_LQR/LQR.ino
@@ -1,5 +1,9 @@
 /** Control Law*/
 const float K[statesNumber] = {0.55192, 8.9867, 0.194, 0.39237};
+
+//K from our calculation
+//const float K[statesNumber] = {-31.6228, -21.2864, 80.7894, 13.4246};
+
 /** Correction factor */
 const float scaleConst = 2.5;