Merge pull request #70 from AndunHH/fixSwitchYZ

Fixing SwitchYZ
AndunHH · Jan 20, 2025 · cdf87f5 · cdf87f5
2 parents 937c45a + 790ef76
commit cdf87f5
Show file tree

Hide file tree

Showing 3 changed files with 16 additions and 1 deletion.
diff --git a/spacemouse-keys/kinematics.cpp b/spacemouse-keys/kinematics.cpp
@@ -183,4 +183,18 @@ void switchXY(int16_t *velocity)
     tmp = velocity[ROTX];
     velocity[ROTX] = velocity[ROTY];
     velocity[ROTY] = tmp;
+}
+
+/// @brief Switch position of Y and Z values
+/// @param velocity pointer to velocity array
+void switchYZ(int16_t *velocity)
+{
+    int16_t tmp = 0;
+    tmp = velocity[TRANSY];
+    velocity[TRANSY] = velocity[TRANSZ];
+    velocity[TRANSZ] = tmp;
+
+    tmp = velocity[ROTY];
+    velocity[ROTY] = velocity[ROTZ];
+    velocity[ROTZ] = tmp;
 }
diff --git a/spacemouse-keys/kinematics.h b/spacemouse-keys/kinematics.h
@@ -10,6 +10,7 @@ void FilterAnalogReadOuts(int* centered);
 void calculateKinematic(int* centered, int16_t* velocity);
 
 void switchXY(int16_t *velocity);
+void switchYZ(int16_t *velocity);
 
 // The following constants are here for more readable access to the arrays. You don't need to change this values!
 // Axes in centered or rawValues array

diff --git a/spacemouse-keys/spacemouse-keys.ino b/spacemouse-keys/spacemouse-keys.ino
@@ -198,7 +198,7 @@ void loop()
   }
 
 #if SWITCHYZ > 0
-  switchXY(velocity);
+  switchYZ(velocity);
 #endif
 
   // get the values to the USB HID driver to send if necessary