From 5de9cf48f855af1cd53dde52db0142180f7fed8b Mon Sep 17 00:00:00 2001
From: Maja Pahor <maja@Majas-MacBook-Pro.local>
Date: Thu, 22 Aug 2024 17:39:59 +0200
Subject: [PATCH] poskus popravka reseta

---
 danijela.js | 11 +++--------
 1 file changed, 3 insertions(+), 8 deletions(-)

diff --git a/danijela.js b/danijela.js
index 7e0c33b..27b1b36 100644
--- a/danijela.js
+++ b/danijela.js
@@ -105,20 +105,15 @@ mi.on('message', (deltaTime, msg) => {
       }
     } else if (Object.values(senzorCCkalibracija).includes(msg[1])) {
       const s = Object.values(senzorCCkalibracija).indexOf(msg[1]) + 1
+      // resetiraj izhodisce quaterniona
       izhodisceQ[s] = prejsnjiQ[s].conjugate()
+      // nastavi CC vrednost na sredino - 64
+	      senzorCC[s] = 64;
       console.log(`senzor KALIBRACIJA ${s}`)
     }
   }
 
   //console.log(`midi in: ${msg} d: ${deltaTime}`);
-
-      /*
-  if (senzorGlaveCC === 0 && senzorRokeCC === 0) {
-    console.log('===== KALIBRACIJA! =====')
-    let izhodisceQGlave = prejsnjiQGlave.conjugate()
-    let izhodisceQRoke = prejsnjiQRoke.conjugate()
-  }
-  */
 })
 
 // Razpon za pospeskomerje