poskus popravka reseta

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